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(57) Abstract: The invention relates to a calibration device (1) for calibrating a working point (TCP) of tools (13) for industrial 
"W robots (8). Said device comprises a plurality of light barriers (5a, 5b) which cross at a reference point of intersection (R). 



(57) Zusammenfassung: Eine Einmess\'orrichtung (1) zum Einmessen eines Arbeitspunktes (TCP) von Werkzeugen (13) fiir In- 
dustrieroboter (8) hat mehrere sich in einem Referenz-Kreuzungspunkt (R) kreuzende Lichtschranken (5a, 5b). 



4/20/2009, EAST Version: 2.3.0.3 



wo 03/059580 A2 llllllillllllilllllillliliilli 



PT, SE, SI, SK, TR), OAPI-Patent (BF, BJ, CF, CG, CI, 
CM, GA, GN, GQ, GW, MI., MR, NR, SN, TO, TG). 

Erkliirung gemalS Regel 4.17: 

— Erfindererkldrung (Regel 4.17 Ziffer iv) nur fur US 
Veroffentlicht: 

— ohne internationalen Recherchenbericht und erneut zu 
veroffentlichen nach Erhalt des Berichts 



Zur ErUarung der Zweibuchstaben-Codes und der anderen 
Ahkurzungen wird auf die Erklarungen ("Guidance Noles on 
Codes and Abbreviations") am Anfangjeder regularen Ausgabe 
der PCT-Gazette verwiesen. 



4/20/2009, EAST Version: 2.3.0.3 



wo 03/059580 



PCT/DE03/00034 



Einmessvorrichtung und Verfahren zum Einmessen eines Arbeitspunktes 

von Werkzeugen fiir Industrieroboter 

Die Erfindung betrifft eine Einmessvorrichtung zum Einmessen eines Ar- 
5 beitspunktes von Werkzeugen fiir Industrieroboter sowie ein Verfahren zum 
Einmessen eine Arbeitspunktes von Werkzeugen fiir Industrieroboter mit 
einer solchen Messvorrichtung. 

Industrieroboter haben zum Anfahren beliebiger Punkte innerhalb eines Ar- 
10 beitsraums mehrere miteinander verbundene Arme, einen Handflansch am 
Ende des letzten Arms der miteinander verketteten Arme, und ein Werl<- 
zeug, das an den Handflansch angebracht ist. Das Werkzeug kann bei- 
spielsweise ein Grelfer, ein SchweilSkopf oder ahnllches sein. 

15 Die Lage und Orientierung des Handflansches oder des Arbeitspunktes ei- 
nes an den Handflansch angebrachten Werkzeugs kann in einem ortsfesten 
roboterunabhangigen Weltkoordinatensystem oder einem ortsfesten auf 
einen Verankerungspunkt des Industrieroboters bezogenen Basiskoordina- 
tensystem erfolgen. Die Beschreibung der Lage der Freiheitsgrade, d. h. der 

20 Achsen und der Handorientierung erfolgt hingegen In Roboterkoordlnaten, 
wobei ausgehend von der Grundachse des Roboters, d. h. des Basiskoordi- 
natensystems, fiir jeden Arm ein Achsen-Roboterkoordinatensystem defi- 
niert ist, das die relative Lage jeder Achse bezogen auf Ihre vorgehende 
Achse beschreibt. Der Zusammenhang der Achsen- 

25 Roboterkoordinatensysteme eines Industrieroboters wird durch definierte 
Koordinatentransformationen beschrieben. Durch Vorgabe der Lage und der 
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Orientierung des Handflansch oder des Arbeitspunktes eines Werkzeugs im 
Weltkoordinatensystem konnen somit durch Koordinatentransformation die 
Achsen-Roboterkoordinaten berechnet werden, um die einzelnen Aclisen 
des Industrieroboters ansteuern zu konnen. 

5 

Die Lags eines Arbeitspunktes eines Werkzeuges, das an den Handflanscti 
des Industrieroboters angebracfit wird, wird durch sogenannte TCP- 
Lagekoordinaten beschrieben. Die Programmierung des Industrieroboters 
erfolgt auf der Basis des IHandflanschs und der festgelegten TCP- 

10 Lagekoordinaten. Die TCP-Lagekoordinaten werden bei jedem Werkzeug 
mitgeliefert und sind als Tool-Center-Point (TCP) bekannt. Die TCP- 
Lagekoordinaten sind ebenso wie die Aoiisen-Roboterkoordinaten jeweils 
ein Vektor mit secfis Dimensionen. Die ersten drei Koordinaten definieren 
die Lage des Arbeitspunktes relativ zu dem Werkzeugbasispunkt des indu- 

15 strieroboters, d. h. des Befestigungspunktes des Werkzeugs an dem Hand- 
flansch. Die anderen drei Koordinaten definieren die Orientierung der Ach- 
sen des Arbeitspunktes relativ zu dem Werkzeugbasispunkt. 

Der Arbeitspunkt des Werkzeugs kann beispielsweise die Spitze eines 
20 Schwei&kopfes sein. Nur wenn die TCP-Lagekoordinaten exakt bekannt 
sind, kann der Arbeitspunkt des Werkzeugs prazise verfahren werden. 

Im Betrieb kann sich der Arbeitspunkt des Werkzeugs jedoch durch Werk- 

zeugverschleilS, Verbiegung etc. andern, was zu einer fehlerhaften Positio- 
25 nierung des Arbeitspunktes des Werkzeugs fiihrt. 

Es besteht daher die Notwendigkeit den Arbeitspunkt von Werkzeugen 
hochgenau einzumessen. 
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In der EP 0 417 320 A1 ist ein Verfahren zum Einmessen des Arbeitspunk- 
tes (TCP) des Werkzeuges eines Industrieroboters beschrieben, bei dem ein 
Einstellpunkt an dem Handflansch des Roboterarms festgelegt ist, wobei 
die Position des Einstellpunktes relativ zu dem l-landflansch bekannt ist. 
5 Weiterhin ist eine Referenzspitze im Arbeitsraum des Industrieroboters auf- 
gestellt. Zum Einmessen des Arbeitspunktes wird die Spitze des Werkzeugs 
auf die Referenzspitze aufgesetzt und die Position und Orientierung der 
Werkzeugspitze in einem Basiskoordinatensystem bestimmt. Dann wird der 
Einstellpunkt des Handfiansches auf die Referenzspitze aufgesetzt und die 
10 Position und Orientierung des Einstellpunktes in dem Koordinatensystem 
des Handfiansches bestimmt. Zudem wird die Position und Orientierung der 
Referenzspitze in dem Bezugskoordinatensystem bestimmt und aus den drei 
Matrlzen eine Transformationsmatrix zur Bezeichnung der TCP- 
Lagekoordinaten des Arbeitspunktes des Werkzeuges berechnet. 

15 

Das Einmessen erfordert einen mehrstufigen Verfahr-Vorgang sowie Koor- 
dinatentransformationen. 

Aus dem US-Patent 6,352,354 81 ist ein Lichtpunktelement zur Erzeugung 
20 eines Lichtpunktsignals an einem Arbeitspunkt eines Industrieroboter- 

Werkzeugs beschrieben. Hierdurch kann die genaue Position des Werkzeugs 
wahrend einer Lernphase beschrieben werden. 

In dem US-Patent 5,929,584 ist ein Verfahren zum Einmessen eines Ar- 
25 beltspunktes von Werkzeugen mit einem Kalibrlerblock beschrieben, der 

vertikale und horizontale Flachen hat. Durch Bewegung des Werkzeugs von 
einer Startposition bis zu einem Beruhrungspunkt des Werkzeugs an einer 
der Flachen und Zuruckfahren des Werkzeugs zum Startpunkt und Wieder- 
holen des Vorgangs fur die andere Flache werden die TCP-Lagekoordinaten 
30 des Arbeitspunktes berechnet. Hierzu ist nachteilig eine aufwandige Koor- 
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dinatentransformation von dem Bezugskoordinatensystem uber die einzel- 
nen Roboterkoordinaten bis zu dem Handflansch erforderlich, um aus den 
Bezugskoordinaten die TCP-Lagekoordinaten im TCP-Koordinatensystem zu 
ermitteln. 

Aufgabe der Erfindung war es, eine verbesserte Einmessvorrichtung zum 
Einmessen eines Arbeitspunktes von Werkzeugen fur Industrieroboter sowie 
ein Verfahren hierzu zu schaffen, um im Betrieb prazise und sclinell den 
Arbeitspunkt von Werkzeugen einmessen zu konnen. 

Die Aufgabe wird mit der gattungsgemalSen Einmessvorrichtung erfin- 
dungsgemaS dadurch gelost, dass die Einmessvorriclitung mehrere sicii in 
einem Referenz-Kreuzungspunkt kreuzende Liclitschranken hat. 

Im Unterschied zu den herkommlichen Kalibrierblocken mit horizontalen und 
vertikalen Flachen kann eine solche Einmessvorrichtung mit Gabellicht- 
schranken relativ klein und leicht aufgebaut und fest im Arbeitsraum des 
Industrieroboters montiert werden. Im Betrieb kann der Arbeitspunkt des 
Werkzeugs, in der Regel die Werkzeugspitze, in den Referenz- 
Kreuzungspunkt der Lichtschranken gefahren werden, um die TCP- 
Lagekoordinaten (Tooi-Center-Point-TCP) neu einzumessen. 

Hierzu hat die Lichtschrankenmesseinrichtung vorzugsweise einen auf einer 
Seite offenen Rahmen mit zwei voneinander beabstandeten parallelen 
Schenkeln. Mindestens im Bereich des vorderen und hinteren Endes der 
Schenkel ist jeweils ein Sender und Empf anger fur zwischen den Schenkeln 
zu dem Rahmen ausgerichtete Lichtschranken vorgesehen. Das Werkzeug 
kann somit in diese U-formige Einmessvorrichtung hineingefahren und so- 
lange dort verfahren werden, bis der Arbeitspunkt, d. h. die Werkzeugspitze 
des Werkzeuges den Referenz-Kreuzungspunkt passiert und beide Licht- 
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schranken unterbrochen sind und demzufolge ein Schaltsignal abgeben. 
Dann werden die TCP-Lagelcoordinaten ermittelt. 

Die LIclitschranken sind vorzugsweise als Infrarot-Lichtschranken ausge- 
fuhrt. 

Das EInmessen des Arbeitspunktes erfolgt vorzugsweise mit den Schritten: 

a) Festlegen der TCP-Lagekoordinaten des Arbeitspunktes des Werk- 
zeuges bezogen auf einen Werkzeugbasispunkt des Industrieroboters 
und eines auf den Arbeitspunkt bezogenen TCP-Koordinatensystems, 

b) Verfahren des Werkzeuges mit Bezug auf das TCP- 
Koordinatensystem solange, bis der Arbeitspunkt des Werkzeuges In 
dem Referenz-Kreuzungspunkt der Lichtschrankenmesseinrichtung 
liegt, 

c) Korrigieren der TCP-Lagekoordinaten um die Differenz zwischen den 
festgelegten TCP-Lagekoordinaten und der beim Verfahren des Werk- 
zeuges in Bezug auf das TCP-Koordinatensystem unmittelbar im TCP- 
Koordinatensystem vorliegenden Lage des Arbeitspunktes in dem Re- 
ferenz-Kreuzungspunkt. 

ErfindungsgemalS wird somit vorgesciilagen, das Werkzeug in Bezug auf 
das TCP-Koordinatensystem zu verfahren, d. h. die Steuerung erfolgt nicht 
wie herkommlich auf der Basis des Weltkoordinatensystems oder Basisko- 
ordinatensystems des Industrieroboters, sondern unmittelbar mit Bezug auf 
TCP-Koordinatensystem. Das TCP-Koordinatensystem hat In der Regel sei- 
nen Ursprung im Arbeitpunkt, beispielsweise der Messspltze des Werk- 
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zeugs, und eine Orientierung in Richtung des Werkzeugbasispunktes, bei- 
spielsweise des Befestigungspunktes des Werkzeugs an dem Handflansch. 

Auf diese Weise wird erreicht, dass die Steuerungsposition des Industriero- 
5 boters unmittelbar auf das TCP-Koordinatensystem bezogen ist und ohne 
welters Transformationen die Verschiebung des Arbeitspunktes relativ zu 
den voriier festgelegten TCP-Lagekoordinaten des Arbeitspunktes bestimmt 
werden kann. Es wird somit die Verscfiiebung des Referenz -Kreuzungs- 
punktes bezogen auf den Ursprung des TCP-Koordinatensystems bestimmt, 
10 wobei der Ursprung des TCP-Koordinatensystems in der Regel den Ar- 
beitspunkt eines neuwertigen Werkzeuges beschreibt. Die TCP- 
Lagekoordinaten konnen somit unmittelbar ohne weitere Transformation zur 
Korrektur der vorlier festgelegten TCP-Lagekoordinaten verwendet werden. 

15 Diese Vorgeliensweise fuhrt einerseits dazu, dass zum Einmessen lediglioh 
ein einfaciier Referenz-Kreuzungspunkt im Arbeitsraum des Industrierobo- 
ters definiert werden muss. Die Einmessvorriclitung kann somit relativ ein- 
fach im Vergleich zu einem Kalibrierblock aufgebaut werden. Zudem er- 
moglicht das Verfaliren das schnelle und einmalige Anfahren des Referenz- 

20 Kreuzungspunktes durcli die Werkzeugspitze, um eine Korrektur der TCP- 
Lagekoordinaten bel VerschleilS, Verbiegung oder aiinliclnes des Werkzeuges 
vorzunehmen. Dies wird auf einfache Weise nur dadurch erreiclit, dass das 
Werkzeug zum Einmessen im TCP-Koordinatensystem gefuhrt wird. Der 
Ursprung des TCP-Koordinatensystems, d. h. der Arbeitspunkt des Werk- 

25 zeugs wird auf dem fruher festgelegten Arbeitspunkt stationar gehalten und 
es werden somit die Basiskoordinaten des Referenz-Kreuzungspunktes der 
Lichtschrankenmesseinrichtung in Bezug auf den fruher festgelegten Ar- 
beitspunkt vermessen. 
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Die Erfindung wird nachfolgend anhand der beigefugten Zeichnungen naher 
eriautert. Es zeigen: 

Figur 1 - perspektivische Ansicht einer erfindungsgemalSen Einmessvor- 
5 richtung mit zwei sich kreuzenden Lichtschranken; 

Figur 2 - Draufsicht auf die Einmessvorrichtung nach Figur 1 ; 

Figur 3 - Skizze eines Industrieroboters mit mehireren Armen und Basis- 
10 koordinatensystem sowie Achsenkoordinatensystemen; 

Figur 4 - Skizze der Verlagerung des Arbeitspunktes eines Werkzeugs 
nacli VersciileiB in Bezug auf ein TCP-Koordinatensystem. 

15 Die Figur 1 lasst eine erfindungsgemal^e Einmessvorrichtung 1 in perspekti- 
vischer Ansicht erkennen. Die Einmessvorrichtung 1 hat einen auf einer Sei- 
te offenen Rahmen 2 mit zwei voneinander beabstandeten parallelen 

Schenkein 3a, 3b. Die Einmessvorrichtung 1 ist somit U-formig. Die Schen- 
kel 3a, 3b sind integral mit einer Halteplatte 4 verbunden, mit der die Ein- 
20 messvorrichtung 1 ortsfest in dem Arbeitsraum des Industrieroboters mon- 
tiert werden kann. 

In den Schenkein 3a, 3b sind diagonal hierzu ausgerichtete Lichtschranken 
5a, 5b vorgesehen, die sich in einem Referenz-Kreuzungspunkt R im Zwi- 

25 schenraum zwischen den Schenkein 3a, 3b treffen. Hierzu ist jeweils ein 
Sender 6 und ein Empfanger 7 pro Lichtschranke 5a, 5b an einem vorderen 
Ende eines ersten Schenkels 3a und am hinteren Endes des anderen Schen- 
kels 3b fur die erste Lichtschranke 5a bzw. an dem hinteren Ende des er- 
sten Schenkels 3a und dem vorderen Ende des zwelten Schenkels 3b fur 

30 die zweite Lichtschranke 5b angebracht. Auf diese Weise wird eine Ga- 
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bellichtschranke geschaffen, die vorzugsweise als Infrarot-Lichtschranke 
ausgebildet ist. 

Die Figur 2 lasst die Einmessvorrichtung 1 in der Draufsiciit erkennen. Es 
5 wird deutlich, dass die Licintschranken 5a, 5b diagonal zwischen den 

Schenkeln 3a und 3b verlaufen und sich im Zwischenraum der Schenkei 3a, 
3b in einem Referenz-Kreuzungspunkt R treffen. 

Ein Arbeitspunkt TCP eines Werkzeugs fur einen Industrieroboter, bei- 
10 spielsweise die Werkzeugspitze, wird zum Einmessen des Arbeitspunktes 
TCP so verfaliren, dass der Arbeitspunkt TCP in dem Referenz- 
Kreuzungspunkt R der Einmessvorrichtung 1 liegt. In diesetn Falle sind bei- 
de Lichtschranken 5a, 5b durch die Werkzeugspitze unterbrochen, so dass 
ein Schaltsignal erzeugt wird. 

15 

Das Einmessverfaliren wird Im Folgenden naher eriautert. 

Die Figur 3 lasst eine Skizze eines Industrieroboters 8 erkennen. Ein Indu- 
strieroboter 8 hat ein Basiskoordinatensystem 0^ oder Weltkoordinatensy- 

20 stem, das ortsfest In Bezug auf das Fundament des Industrieroboters 8 

ausgerichtet ist. An dem Sockel 9 befindet sich eine Kette von iiber Gelen- 
ke 1 0 miteinander verbundene Arme 1 1 . Fiir jeden dieser Arme 1 1 ist ein 
Achsen-Koordinatensystem Oj, ^3 definiert, mit dem Position und Ori- 
entierung des jeweiligen Endes des entsprechenden Arms 11 in Bezug auf 

25 das zugeordnete Gelenk 10, mit der Arm 1 1 mit dem vorhergehenden Arm 
1 1 verbunden ist, beschrelbt. 

An dem Ende der Kette von Armen 1 1 befindet sich eine Handflache 1 2, an 
die das Werkzeug 13 angebracht ist. 
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Fur das Werkzeug 1 3 ist ein TCP-Koordinatensystem festgelegt, das 
einen Ursprung in dem Arbeitspunkt TCP des Werkzeugs hat. Fur das 
Werkzeug 13 werden auf der Basis dieses TCP-Koordinatensystems Otcp 
5 TCP-Lagekoordinaten bereitgestellt, die die Position und Orientierung des 
Arbeitspunktes TCP in Bezug auf den Werkzeugbaslspunkt W am Hand- 
flanscli 12, d. h. in Bezug auf den Befestigungspunkt des Werkzeugs 13 an 
dem Industrieroboter 8 definlert. 

10 Urn die TCP-Lagekoordinaten im Betrieb bezogen auf den Werkzeugba- 
slspunkt W des Industrieroboters 8 sclinell und mit geringen Rechenauf- 
wand einmessen zu konnen, wird erfindungsgemaS die Werkzeugspitze des 
Werkzeugs 1 3 in den Referenz-Kreuzungspunkt R der ortsfest montierten 
Einmessvorrichtung 1 auf der Basis das TCP-Koordinatensystems ver- 

15 faliren. Es erfolgt somit eine auf den Arbeitspunkt TCP bezogene Interpola- 
tion des Verfahirweges beim Fuhren des Werkzeugs 13 durcli den Indu- 
strieroboter 8. Der Ursprung des TCP-Koordinatensystems wird hierbei 
stationar in Bezug auf die festgelegten TCP-Lagekoordinaten des Ar- 
beitspunktes TCP gehalten. Aus dem Verfahrweg kann direkt die Verschie- 

20 bung des Arbeitspunktes TCP bei VerschileiB oder Verbiegen des Werkzeugs 
13 in den TCP-Koordinaten bestimmt werden. Es wird also quasi eine Ver- 
schiebung des Referenz-Kreuzungspunktes R in Bezug auf einen ursprungli- 
chen Referenz-Kreuzungspunkt Rjcp bestimmt. Damit entfallt die Notwen- 
digkeit, aufwandige Koordinatentransformationen durchzufuiiren und es 

25 braucht lediglich wie in einem Schritt der Referenz-Kreuzungspunkt R ange- 
fahren werden. 

Die Figur 4 iasst das Werkzeug 13 mit dem TCP-Koordinatensystem 0^^? 
erkennen, dass selnen Ursprung im Arbeitspunkt TCP des Werkzeugs 13 
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hat. Fur den Fall der skizzierten Verkrummung des Werkzeuges verlagert 
sich der Arbeltspunkt TCPi in Bezug auf den vorher festgelegten ursprungli- 
chen Arbeltspunkt TCPp . Die TCP-Lagekoordlnaten sind urn diese Verschie- 
bung ATCPo = TCPi-TCPo zu korrigieren. Da erfindungsgemal^ die Steuerung 
5 des Industrie-Roboters 8 in Bezug auf das TCP-Koordinatensystem Oj^p er- 
folgt, wird die Differenz zwischen den ursprunglicii festgelegten TCP- 
Lagekoordlnaten TCPo und die Lage des neuen Arbeitspunktes TCP, eines 
verschlissenen Werkzeugs 1 3 unmittelbar ermlttelt. 
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Anspruche 

1. Einmessvorrichtung (1) zum Einmessen eines Arbeitspunktes (TCP) 
. von Werkzeugen fiir Industrieroboter (8), dadurch gekennzeichnet, 
5 dass die Einmessvorrichtung (1) melirere sich in einem Referenz- 

Kreuzungspunkt (R) kreuzenden Liclitschranken hat. 



2, Einmessvorrichtung (1) nach Anspruch 1, dadurch gekennzeichnet, 
dass die Einmessvorrichtung (1) einen auf einer Seite offenen Rah- 

10 men mit zwei voneinander beabstandeten parallelen Schenkein {3a, 

3b) hat, wobei mindestens im Bereich des vorderen und hinteren En- 
des der Schenkel (3a, 3b) jeweils ein Sender und Empfanger fur zwi- 
schen den Schenkein (3a, 3b) diagonal zu dem Rahmen ausgerichtete 
Lichtschranken (5a, 5b) vorgesehen sind. 

15 

3. Einmessvorrichtung (1) nach Anspruch 1 oder 2, dadurch gekenn- 
zeichnet, dass die Lichtschranken (5a, 5b) Infrarot-Lichtschranken 
sind. 



20 4. Verfahren zum Einmessen eines Arbeitspunktes (TCP) von Werkzeu- 
gen (13) fiir Industrieroboter (8) mit der Einmessvorrichtung (1) nach 
einem der vorhergehenden Anspruche, gekennzeichnet durch 



a) Festlegen der TCP-Lagekoordinaten des Arbeitspunktes (TCP) 

25 des Werkzeuges (13) bezogen auf einen Werkzeugbasispunkt 

(W) des Industrieroboters (8) und eines auf den Arbeitspunkt 
(TCP) bezogenen TCP-Koordinatensystems, 

b) Verfahren des Werkzeuges (13) mit Bezug auf das TCP- 

30 . Koordinatensystem solange, bis der Arbeitspunkt (TCP) des 
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Werkzeuges (13) in dem Referenz-Kreuzungspunkt (R) der 
Einmessvorrichtung (1) liegt, 

c) Korrigieren der TCP-Lagekoordinaten um die Differenz zwi- 
5 schen den festgelegten TCP-Lagekoordinaten und der beim 

Verfaliren des Werkzeuges (13) in Bezug auf das TCP- 
Koordinatensystem unmittelbar im TCP-Koordinatensystem 
vorliegenden Lage des Arbeitspunktes (TCP) in dem Referenz- 
Kreuzungspunkt (R). 
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Fig. 2 
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Fig. 4 
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